Du mußt das selbstverständlich nicht nur für das std::set<>sondern auch für die std::map<> umsetzen. Am besten kommentiere ersteinmal den unteren Teil des Codes von setPositionSensoraus und wenn das für 'std::set<>' funktioniert, kommentierst du den 'std::map<>' Teil wieder ein und änderst diesen dann entsprechend ab!